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manipulator, and identifying singular configurations and their characteristics. 

This naner therefore serves two functions: a new general method for the solution of the inverse velocity problem 
is are ^ for iHe resown of,* JUm ro,os of a « . of 

freedom manipulator useful for telerobotic and industrial robotic application. 

1 ‘ ‘"^Tnverl velocity problem for a redundant manipulator is underdetermined. That is, an infinite number of joint 
must be identified. 

Several approaches for the resolution of "optimal" joint rates for redundant m^tputetoR tave rn ^opc^d. 
These techniques can be classified as local (e.g. see Hollerbach and Suh[l] and the references of [1], [2] [3] and [ ]), 

. . . ^ Kazerounian and Wang[2] and the references of [2], and [3]), kinematic function based ( .g. 

Wampler and Bak^ [3]), and constraint based (e.g. see Baillieul[4]). Global, kinematic function, and constraint tech- 
niciu« (in a local sense) have the advantage of maintaining the same joint displacements during repetitive execution o 
^ have the disadvantage of being nonrepetitive, and globally nonopumal, but remain an 

important technique where insufficient information or computational time is available for global optimization. 

Analytical derivation of expressions for the inverse velocity solution allow a computational efficiency difficult to 
achieved numerical solution schemes. Works by Sugimoto[5] ("orthogonal basis" decomposition of ^coordi _ 
nates) Hunt[6] (direct inversion of a screw coordinate matrix (Jacobian) using convenient frames of reference) and 
Stanisic et al.[7] (canonical reference for three parameter motion) are recent examples of techniques for the den atio 
of analytical expressions for the inverse velocity solution of nonredundant manipulators. 

In this work an inverse velocity solution based on a decomposition of screw coordinates is presented (Sections 
2 3 and 4) and is applied to the derivation of analytical results for a seven revolute (7R) manipulator (Section 5). 
d^omposiuon identifies reciprocal screw quantities (terminology reviewed in Section 2) used for a part, cult* pint 
velocity 0 solution and a basis for the Jacobian null-space useful in joint rate optimization. Optimization for quadratic 
objective functions yields direct solutions for the optimum (local) joint rates in terms of pseudo-inverses of a weighting 
of the null-space basis. These solutions require the inverse of matrices of reduced order (e.g. a scalar quantity or 
seven degree of freedom robot), in comparison to pseudo-inverses of the manipulator Jacobian. 

The 7R manipulator analyzed features a spherical base, a revolute elbow, and a spherical wrist. This joint layout 
was prised by Hollerbach [8] as an "optimal" seven degree of freedom layout, for which one of the objectives was die 
elimination of singularities caused by single joint displacement conditions. As such, the robot should be usefu 


69 


telerobotic and industrial application where a degree of autonomous motion is required (i.e. preplanning for singularity 

"SJn. 15 "? PO f ble )- ««»» »» derived for the inveme velocity solufion to dl 

configurations. Singular configurauons are examined and characterized in tenns of the screw decomposition. 

2. Resolving Joint Velocities Using Reciprocal Screws 

ters (four for'dM li!”!! K hav ‘ n « a " associated linear P itch - H 1] As such it represents five independent parame- 
ters ( our for the line, one for the pitch). Associating an amplitude acting on the screw yields six independent parame- 

momiuT qUanUt 7 ** natUnd entitics for describin « spatial instantaneous motion (velocities) ^nd forces and 
moments, (i.e. any velocity can be considered to be a rotational velocity about an axis and a translational veloc j IZ 

mT, SSST" a " d “ i! “ 10 3 f0ree * a - ■ coupleTaEe 

A screw can be represented as a dual vector by its screw coordinates, {$; $J r , 

$ = {$: K) T = (L; L 0 + p L L) T (1) 

t7 d L ° rc T C 5 V * Iy the direction of ^ line ^ its moment about a reference origin (Plucker line coordi- 
es), and p L is the pitch of the screw. A screw quantity is represented by the product of an amplitude and a screw, 

S = a($; = {s; s^} r ^2) 

If S is the velocity of a rigid body, (a twist about a screw), then a is referred to as the twist amplitude s is the anmilar 
w locity vector of the body and s fl is the translational velocity of a point on the rigid body (extended to be) coincfdent 
fwftr ferenC , e h!'^ n ' ? re P resents a s y st em of forces (a wrench acting on a screw), l is the resultant vector ofthe 
of all fo^aCS.S;” ° f lhe m0mMS **"* °"' b ° b0dy ^ ° f 1 “* ra0 " , ' ms 

The reciprocal product of two screw quantities is the inner product, 

®1 X ^2 = S] ' S 02 + S 0 J • S2 ^ 

The reciprocal product of a "twist" and a "wrench" quantifies a rate of work Two screws are rerinmrai «,hon ,h 

* n ’° ti0 " TT * Si ' s " bjecKd 10 a for “ mom described 
A sefof Hh^riy independent screws forma an r-sysrem. 

If a rigid body is acted upon by twist amplitudes about a chain of n screws the resulting velocity, M, is 

<*,$, + a 2 $2 + • * • + 0,$, = M 

equivalent to the columns of *e m^ipul^L^obTan wfil,' res^’t Selra^ToT iXSTeTl ^ [IT" $ » 

- — 

such tofiTs -'0 r “K ProCal ”7 ql,anddes - “• “ * ™"ch on a screw, B is known 

ductstfbSh sL * > *S B. ,WBt amP,1 “ Kl ' (i ° iW '* ) ““ * “king reciprocal pre- 


and therefore 


(at$i + a 2 $2 + ■ • • + aA) X » = aA x B = M x B 
o* = = (M % B)/($. x B) 


(5) 


Equation (5) represents a virtual work expression, i.e. the rate of work done by the end effector moving at the rate M 
subjectod^othe ** ”* * ^ ^ ^ j0int Ve,0CUy ’ *' *°« $ " When 

3. An Inverse Velocity Solution Based on a Decomposition of Screw Coordinates 

remov^TeV m”" ° t 1 “" lado ? (5X “ resolved ’ iB comribotioii u lhe end effeclor velocity can be 

Sr^^fng'^^gj ; ° f ‘‘S T Ve T ,ty ' 6g ' 1 ^ "T a quantity recipn,. 

decnmpoaZ^wTtetcfion. " ”* < " ,an,,des “ fdddd -)-nual 
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IS, 


j - 1 

$y = By + J) 
1=1 


( 6 ) 


, O v * _ 0 i < i and B* = {b ; b,} T is defined as the wrench complement. By sequentially taking reap 
where B, x $. - 0, <j, and 1 n v r * - R v f$ - a. . $ i - • 1 • - «i;$i) = 0 for 1 ^ re< l uired twist 

products with B,, and noting B, X B i = B ; X B < - B y X (5. a <-n>*-i 
amplitudes, Cty, are determined to be 


>- 1 


tty = ($„ x B,)/($, X Bi). where $„ = $> - E 


(7) 


Notice to is a Gram-Schimdt type decompose [131 where to inner proto, is to reciprocal product. and dnal vec- 

^O^^^s^t^ n to'dwomptotto S renum^ n mi^Bf v^ue*and X d^vah!es| t of 

Oij, i <;. of equation (7) correspond to the negatives of the vdu^O i, ^ For the deposition of the 

of one (1) associated with $, form a vector for the null-space basis of [J] (= l$t 
remaining screws $, and its associated null B, are not considered. 

IB*] = [J][d] (8) 

where [B‘] = [Bj Bj • ■ ■ B,* 0 ■ 0 1 . and d„ = 1 if (•/. or -a, if i<j and iSr. or 0 otorwise 

■SSrSxrrsS 

0rdCr a — ^ velocity solution can be formed by decomposing M into joint rates about the "linearly indepen- 


dent" screws of [J], i.e. M - E where 


<? W ,=(My> C »;)/($> XB>). j=r, 1,-1, 


with Mj = M - £ ^ m part^ n 

m=j + 1 


(9) 


( 10 ) 


A general joint velocity solution can be expressed as 

= (<?W„ X i + 

where la] is a nnll-spaee for to join, screw coordinates (Jacobian). The panicular joint velocity solution rfeto«^ 
(9) corresponds to a solution with i,j„ = 0 for j>r. If this panicular solution ts used and W ts * 

' c „ klmlls 0 f [d], recalling that [dl has nni, values on to diagonal and ,s upper triangular, to [M of equauon (10) 
^seerTto concspond to Upvalues of q, , y >r. These raws shall he referred toastoredundan, joint rates. 

Optimizing to joint rate solution involves finding to optimal basis multipliers. (1|,. (equivalent to the optnto 
-rednntoT 3 toes). Snbstitufion into equation (10) then yields to optimal join, rants. For example consider a 
w^htetoumsquare of die joint velocities, i.e. / at/ = ([W]({q)pon + lal(3.))) 2 , where [W] is a weighting matrix. D„. 
ferentiating f obj with respect to (X) and equaling lo zero gives 

W D p< = - ([a] r ['W] T f\V][a]r 1 [a] T [W] r [W ](^ } pa n 


(11) 


Details on using the null-space basis for the optimization of joint rates for obstacle avoidance joint displacement 
minimization, and iterative leas, squares displacement closure can be found ,n [ 01 In each care 
ioint rates are optimized for quadratic objective functions, resulting in direct soluuons for the optimal redundant joint 
E Tn re's of a left pseudo..nverse[13] of a weighting of to null-space basis, similar to tot of equation (11). 
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x( "- r) “ d - <eg - for a -- of ^ -» 

i . . ThC re . SuJ . t f of * e sc , rew decomposition characterize the redundancy of the manipulator, indicate the rank of (he 
facobian, and allow the solution of the inverse velocity problem. The method is suitable for numerical application for 
jWuch the computational costs are discussed in [9]. The method is also useful for the derivation of explirif expressions 

IZ T " U SP K a f e baS ‘ S / nd nul1 reci P roca l P roduct wrenches. These expressions allow analytical solution of 

verse velocity problem, and are useful for the identification of special configurations of the analyzed manipulator 
as is demonstrated with an example in Section 5. p ior , 

4. Multi-arms having Common Redundant Degrees of Freedom 

Consider a system comprised of m manipulators (arms) sharing n c common joint degrees of freedom The Jaco- 

.h™ T aniP a l°’l, ,S Composed of ** j° int screw coordinates individual to the particular manipulator, [$] , and 
the screw coordinates of the common nf rfci : A r ti rr/hi p 


- * J ^ IllUi 

the screw coordinates of the common degrees of freedom, [$],., i e fJl - rr$i 

^ assumed to span the task requirements of the <th manipulator, rendering the [$] e joint degrees of freedom "redun- 
dant . The individual manipulator joint axes may also have redundancy, (i.e. >/■,-). 

The screw coordinates of [J], can be decomposed yielding [B], and the null-space basis [a], .The 

null-space bases for each arm can be combined, concatenating the columns for the common degrees of"* freedom to 
yield a null-space basis for the Jacobian of the entire manipulator system. That is. 


[$l C6x . ]• The screws [$], 


[J][a] = 


0 

[$] 


m6x *m 


[$] 


^6 XHc 


x (2>t ' r *)+*e) = ( 1 2) 


6m x (£*, + n c ) 





toll 



< 

► = i 


{?}* 


iq ) mpari 

[q)c 

(X"i+*c) x 1 

< J 


X (2>, - r,-)+n c ) Xl 


03) 


' (Z*t+*c) x 1 

NoKtoamm-sp** basis is nota funclion of frame of reference. Hiat is. a convenient frame of reference can be mil- 
[wT P °" e "‘ aSSe ""’ led ““ ^ m “" i - ann exam P'“ is 

5. Analytical Expressions for the Inverse Velocity Solution of a 7R manipulator 
Overview 

and nnfjrt? T )Siti0n f SCre ^' COOrd i nates presented in the previous section is used in deriving expressions for [a] 
and [B] for the 7R manipulator illustrated in Figure 1. The manipulator features a spherical group of joints at the base 

Z*nhS-» WnSt f H ° er ^ aCh[8] S “ ggeSted th ‘ s j° int la y° ul 35 being the "optimal" for a 7R manipulator, for which one of 
the objectives of optimality was the elimination of singularities. 

Based on the results of the screw decomposition special configurations of the manipulator are identified. These 

?.?» 10 CaSCS ? hen groups ° f Joint 3X65 t* 00 ™ line arly dependent and yet the manipulator retains 

ull motion ability, and to cases of joint dependency leading to motion ability degeneracy (singular configurations) 

AeTv^T P0S,tl ,° nS U i Smg T f T eS 0f reference m performed to form compact analytical expressions for use in 
the reverse kmemauc soluuon for all non-singular configurations of the manipulator. Singular configurations are exam- 
ined and characterized within the context of the screw decomposition. g C exam 

A screw decomposition 

Solution of the inverse kinematic problem can be performed with respect to any frame of reference. A frame of 
reference was chosen as: z Ttfx aligned in the direction of $ 5 ; y r , fx in the opposite direction to that of $ 4 ; with the origin 
of the reference frame located at the intersection of the three wrist axes, see Figure 1. This reference frame was chosen 
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tt, exploit the decoupling provided by the spherical wrist, and to minimize the c^plexityoftheJacobian terms. With 
respect to this reference frame the screw coordinates of the joint axes (columns of the Jacobian) are ^ 

= (S 2 C 3 C 4 + C 2 S 4 , -S 2 S 3 , -S 2 C 3 S 4 +C 2 C 4 ; -S 2 S 3 (C 4 *+A), -S 2 C 3 g-(S 2 C 3 C 4 + C 2 S 4 )A, S 2 S 3 S 4 g) 

= {-S 3 C 4 , -C 3 , S 3 S 4 ; -C 3 (C 4 g+A), S 2 (g+C A h), C 3 S A g} T 
$ 5 ^* = {S 4 , 0 , C 4 ; 0 , -AS 4 , 0 } r 

( 14 ) 

SJ * 1 = ( 0 , - 1 , 0 ; -A, 0 , 0 } T 
$S** = {0,0, 1; 0, 0, 0} r 
$6^' = (S 5 , -C 5 , 0; 0, 0„ 0} r 

= (-C 5 S 6 , - 5 5 S 6 ,C 6 ; 0 , 0 , 0 } r 

Decontporidon of the screw set in the Oder. lord - (5. 6, 7, 4, 3. 2. 11. yields the null meiprocal wrenches. 

B?^ 1 = (0,0,0; 0,0, 1) T 
B ^ 1 = { 0 , 0 , 0 ;S 5 ,-C 5 , 0 } r 11 

B 5 ^* = { 0 , 0 , 0 ; -C 5 S 6 , -S 5 S 6 , 0 } r 
B ^ 1 = {-A, 0 , 0 ; 0 , 0 , 0 } T 
B ^ 1 = { 0 , -S 4 A, 0 ; 0 , 0 , 0 } r 
B$ x = { 0 , 0 , C 3 S 4 g; 0 , 0 , 0 } T 
B^ 1 = {0,0, 0;0, 0,0} T 

A particular joint rate solution can now be resolved. 

Let NT* 1 = {«,, to,, co„ v„ v,, v,} T represent the 
required task space motion. This screw quantity can be 
explicitly decomposed onto the joint screws yielding, 

q 2 = MxB? n /$? n X B f‘ = v * / ( c 3'S 4 *) ( 16) 

. (M-q 2 $^‘)xB^ _ l 

q 3 = — ~ZZT\ - -t v y * - " ' * 


(15) 




C^4g 



ybau 


x bat* 


etc . 


Figure 1 - 7 R Spherical-Revolute-Spherical Manipulator 


where q t s 0, 


Alternatively efficient customized code (ignoring zero (0) operanons and one (1) mulnphcaomts) can be ^preduced . « 

this point for the paiticular joint rale solution. The operations required for such a solution 1 

uus point lor me p« J . , - 2 • 5 xand 4 + , q 5 : Ox andO + , for a total of 18 x and 13 + . No 

com^mational^ costs * vt involved in lining Uti^iprecal wrenclres once dm lacohian screw cooedinares (equarion 

(14)) are known. , 

The first joint axis for this order of decomposition corresponds to the redundant screw. Decomposing the screw 

coordinates of this joint yields the null-space basis, 


[a] = d n = 


1 

-S 2«S 3/C3 

(-S 2 g-S 2 C 4 A-C 2 C 3 S 4 A)/(C 3 S 4 A) 

0 , 
(S 2 C A S 6 g+S 2 S A C s C 6 g +S 2 S 6 h)l(C 3 S A S 6 h) 
S 2 S 5 gl(C 3 h) 

-S 2 C 5g/(C 3 SfiA) 


( 17 ) 


t Qetails are included aj Appendix 1, S; = Sin(0j), C; — Cos(0j) 
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2tfi P , reSSi0nS in w C nuU ; spac ® basis indicate ^ *4 has no component in the null (is linearly independent), and 

Swv ??*!? (SPCC1 1 | con ®S lu f tlons excepted) joints $, , $ 2 , $3, $ 5 , $e and $7 as a group have one degree of 
redundancy. This basis can be utilized in the optimization of the joint rates (e.g. equation (11)). 

Special configuration identification 

Conditions which cause a normally non-zero wrench, B„ to become null correspond to special configurations of a 
manipulator. These special configurations may correspond to a linear dependency within a "redundant group” of joints 
causrng the joint initially chosen to be last (e.g. joint 1 in the above decomposition) to become linearly iSepLent and 

hence unsuitable as the redundant joint. In this case reordering the screws with one of the linearly dependent joints as 

the redundant joint will yield a complete set of [B], J 

sion ofthe mdf'sna^ 1 nfrnf °i T ^ 0011 J° nd tofurth <* joint linear dependency, (i.e., an increase in the dimen- 
!r 1 J h ?' S CaSC ’ T enng ° decomposition will find r <6 non-zero wrenches, and there 
Thi ™ „ set of linearly independent wrenches, W„ i=l,6-r, reciprocal to the screws of [J], where r is the rank of [J] 
The manipulator will not be able to instantaneously produce motions having non-zero rates of work subject to W This 
corresponds to a 1 loss of a degree(s) of instantaneous end effector motion capability, and is commonlyreferred 'to as a 
singular, t y . In [9] the authors present a scheme for instantaneously planning "optimal" alternative motion specifications 
satisfying the required reciprocity with W, , for manipulators at or near singular configurations. 

,0. in H? ^ bove decomposition demonstrated that for the 7R manipulator, typically any one of $ 3 , $ 5 , $, and & 
could be chosen to represent the redundancy (the "redundant joint”) of the manipulator. Furthermore, since six typi- 
cally non-zero B values were found, the Jacobian was seen to normally be of full rank. 

Examination of the wrenches of equation (15) reveal null B values occur if C 3 = 0, S 4 = 0 or S 6 = 0 If C =0 

if T - n fLn '<C ^ COme , linea, ? y f^d™ 1 causin 8 $1 tobe unsuitable choice for redundant joint. Similarly 
R^Hn^f J?* 7 dependent, again rendering $, as an unsuitable choice for redundant joint 

d f om P° s,Uon (Performed below) in both of these cases will find six non-zero B values, indicating 
con gura ons do not correspond to singularities. Reordering the decomposition for S 4 = 0, finds only five 

non-zero wrenches indicating a smgular configuration. This case and multiple joint displacement conditions leadfne to 
loss of task space freedom are considered later. umuiuons waning to 

A second screw decomposition 

able fri ^7?*- o"^ '"aft ** 01 hasthe Anal joint axis screw coordinates to be decomposed would be suit- 
spherical 

is in * e opposite directiOT 10 - of *<• ?he - int — 

$i^ 2 = (S 2 C 3 ,-S 2 5 3 ,C 2 ;0, 0, 0) r 
SS^ 2 = {-S 3 , -C 3 ,0;0, 0, 0) r 
% 7 f2 = [0, 0, 1; 0,0,0) r 
$4^ 2 = {0, -1, 0; g, 0, 0) r 

= {-S 4 , 0, C 4 ; 0, -S 4 g,0} r 

$6 /2 = (^4^5. -Cs, S 4 S s \ C 5 (g+C 4 h), S s (C 4 g+h), S 4 C 5 h) T 

%¥ 2 = {-C a CsS 6 -S 4 C 6 , -S s S 6 , -S 4 C s S 6 +C 4 C 6 ; S s S 6 (g+C 4 h), -g(C 4 C s S 6 +S 4 C 6 )-C 5 S 6 h, S 4 S 5 S 6 h} T 
Decomposition ofthe screw set in the order, $ord = {3, 2, 1, 4, 5, 6, 7), yields the null reciprocal wrenches 
®S^ 2 = (0, 0, 0; 0, 0, l) r , B 2 * /2 = (0, 0, 0; -S it -C 3 , 0) T , Bf^ 2 = {0, 0, 0; S 2 C 3 , -5 2 S 3 , 0} r 

BJ^ 2 = {g, 0, 0; 0, 0, 0} r , By? 2 = {0, -S 4 g, 0; 0, 0, 0) r , Bg^ 2 = (0, 0, S 4 C 5 h ; 0, 0, 0) r 

B?^ 2 = {0, 0, 0; 0, 0, 0) r 


08 ) 


( 19 ) 


“ d ’ he telS ^ "V is (he 
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Examination of the ‘(^StT 04H1TO ie Nimble for us<x 
^ra"«uron° S oT screw Coordinates prov.de expmssions for the inverse vetoed, soittaon for al. 
non-singular configurations of the manipulator. 

join. <1 isplaeement co n#tta 

^Xir^am'Sng aLSoTe^ifnocal product witt , W. A tfecompositton is performed beiow 
forS4 = 0, generating analytical expressions for ami rhe'joitH screw coordinates of equations (14) 

C7Z 'JSS^SZfS^S ^ UJS^SSL* *Z eases am - per- 
formed below. The four cases are illustrated in Figure 2. 

— » S 4 = 0 

Using ref 1 as the reference the screw coordinates for S 4 - 0 reduce to: 

$"/' = {S 2 C 3 , -S 2 S 3 ,C 2 ; -S 2 S 3 (g+h), - S 2 C 3 (g+h), 0} 

$«/i = (-Si, - C 3> 0; - C 3 (g+h), Si(g+h), 0} 7 UU! 

$f l = {0,0, 1; 0, 0, 0) T 

$ref i ^ 1 _ $«/ 1 > $«/ 1 as in Equation (14) 

. , . tp j_rsA749l'U (shifting 3 to the end when a null B"^ 1 is 

Decomposing the screw coordinates in the order $ord - (5, 6, , , , . ). ( 

found), yields: 

R «/ 1 n ref i B «/ 1 g«/ 1 ^ ; n Equation (15) 

5 ’ (21) 

B 2 fX = (0, Si(g+h), 0; 0, 0, 0} 7 

B^ 1 = {0,0,0; 0,0, 0} 7 , B"-^ 1 = {0, 0, 0; 0, 0, 0) T 

The Jacobian null-space basis generated by the decomposition of $/ and$ 3 is. 


[a] = 


1 S 2 C 3 /S 3 o 0 -(C 2 S 3 S 6 -S 2 S 5 C 6 )/S 3 S 6 -S 2 C 5 lSi - S 2 S 5 /S 3 S 6 

0 0 1 0 0 0 1 


( 22 ) 


, tr i yuref i _ [q o 1' 0, 0, 0) 7 indicating that a point on the end effector coinciding 

->S 2 = 0andC 3 =0 

Again using ref 1 as the reference the screw coordinates for S 2 = 0 and C 3 - 0 reduce to: 

$"/' = (S 4 , 0, C 4 ;0, -S 4 fc, 0) T 
$«/i = (-C 4 ,0,S 4 ;0,g +C 4 fi, 0) r 
$3^ 1 $4^ 1 , $5^ 1 , $6^ 1 1 $7^ 1 as in Equation ( 14 ) 

Decomposing the screw coordinates in the order $ord = {5, 6, 7, 4, 3, 2, 1), yields. 

B r 5 €f \ B r 6 ef \ Br^ 1 , B 4 e/l > B ? /] as in Equation (15) 

Bf i = (0, 0, 0; 0, 0, 0} 7 , Bf* 1 = (0, 0, 0; 0, 0, 0} T 

The Jacobian null-space basis generated by the decomposition of $f /] and is: 


(23) 


( 24 ) 


75 



[a] = 


, £ 0 “1 o o oo 

[0 1 {g+C A h)/S A h 0 <S A C s C 6 g+C A S 6 g+S 6 h)/S A S 6 h -S s g/h C 5 g/S 6 h 

A screw reciprocal to $, • • • $7 is W'* 1 = (0, 0, 1; 0, 0, 0) r . 


( 25 ) 



4 S. 




Figure 2 - Singular Configurations, (a) S A = 0, (b) S 2 = 0 and C, = 0, (c) S t = 0 and C s = 0, (d) S 2 = 0 and s 6 = 0 
^ = 0 and Cj = 0 

Using 2 as the refa-ence the screw coordinates for S 6 = 0 and C 5 = 0 reduce to: 

$5^ » $S^ . $3* , $4^ , $f 2 as in Equation (18) 

$«^ 2 = {C A , 0, S A \ 0, C A g + h, 0) r 

V? 2 = {-S 4 , 0 ,c 4 ; 0. -S A g, 0) T 

Decomposing the screw coordinates in the order $ord = {3, 2, 1, 4, 5, 6, 7), yields: 

B^ 2 . BJ^ 2 , BJ^ 2 , BJ^ 2 as in Equation (19) 

B^ 2 = (0, 0, 0; 0, 0, 0) r , B$* 2 = {0, 0, 0; 0, 0, 0} r 

The Jacobian null-space basis generated by the decomposition of $J^ 2 and $$* 2 is: 

[ a ]~ c * h ' s 2g • Sjh/g -(S 2 Ssg+S2C A Ssh+C2C 3 S A h)/S 2 S A g o (C A S s g + k)/S A g i n 

0 0 0 0 -1 0 1 

A screw reciprocal to $, • • • $7 is W* 2 = {0, 0, 1;0, 0, 0} T . 


(26) 


(27) 


(28) 


Using ref 1 as the reference the screw coordinates for 5« = 0 and C< = 0 reduce to- 
$T^‘ * (5 4 , 0, C A ; 0, - S A h, 0) r 

SS^ 1 . $5^’, $5^', SJ'f 1 as in Equation (14) 

St* 1 = (0,0. 1; 0, 0, 0} T 


(29) 


^ ^ ° rder ** = (5 ' 6 ' 4> 3 ’ 2> 1,71 (WhCre 7 iS “ 10 ** end due to a null 


B?* 1 = (0,0,0; 0,0, l) r , B^ 1 = (0,0, 0;5 S , -Cj.O} 7 ", BJ* 1 = (-*,0.0; 
B ? 1 ~ (W 2 + Ss 2 )){-hS A C 5 S $ , - hS A (h 2 + 5?), 0; S A C s 2 h 2 , S A C 5 S 5 h 2 , 0} r 
= (*C3C4g-C3A+0(42fi, 53^+53^4^+032^54, C354g; -53C4-O3254-Q425J, 


-C 5 5 5 , - 5 5 2 , 0} r 

■Ca+042 +ds 2 Cs , 0) r 


(30) 
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( 31 ) 

W^ 1 = (-S 5 , C 5 , -C4S5/S4- 


B^ 1 = (0, 0, 0; 0, 0, 0} T , B^ 1 = (0, 0, 0; 0, 0, 0) r 

where 0132 , ou 2 , and 052 are given in Appendix 2 

The Jacobian null-space basis generated by the decomposition of $ 7 * 1 and $T^ is. 

r . [1 0 -1 0 0 0 0 l r 
W = lo 0 0 0-10 lj 

A screw quantity (not normalized) reciprocal to $, • • • $7 is 
S 3 C 5 lC 3 S A \C 5 h. S 5 h , 0} r . 

Further Conditions of Degeneracy 

Each of the above conditions correspond to a single loss of task space motion freedom. Further 
placement conditions leading to the loss of more than one motrondegree of freedom can be dbseived by exam 
*e reciprocal wrenches of equations (21), (24), (27), and (30). These multiple conditions inctade. S 4 - 0,1 S 3 -0,mA 
C _ o- and S A = 0 S 5 = 0, and S 6 = 0; both leading to a loss of two degrees of task space freedom. The muluple co - 
dition S 2 = 0, S 3 = 0, S 4 = 0, S 5 = 0, and S 6 = 0 results in a loss of three task space motion degrees of freedom. The 
manipulator can never lose more than three degrees of freedom. 

6. Conclusions 

The general method for the inverse solution of manipulator joint velocities based on a decomposition of screw 
coordinates presented in this work, has the advantage of inherently identifying a basis for the null-space of the Jacoban. 
The null-space basis has been shown to be useful for the resolution of locally optimum joint velocities, generating direc 
^ludons^Toptimal joint rates in terms of a pseudo-inverse of a weighting of the basis for quadranc joint rate 
objective functions. The inverse velocity solution method has been demonstrated to be suitable for the derivation of 
analytical expressions for manipulators by application to a specific example. 

Efficient resolution of the joint velocities for the spherical-rcvolute-spherical (7R) manipulator is possible using 
the analytical expressions derived in this work. The identification of the special configurations of the manipulator, and 
the characterization of singular configurations, make this a complete solution. 
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Appendix 1 - Generation of the Screw Coordinate Models 

In terms of Denevit and Hartenberg parameters[14] the 7R manipulator links can be described as tabulated in 
Table 1. The following rotation matrices can be found, 


[R], = 


[R ] 4 = 


[R ] 7 = 


C 1 0 
Si 0 -Cl 
0 1 0 

c* 0 ’^ 4 ) 
s 4 0 c 4 
0 -1 0 

Ci -S^ 0 
S 7 C 7 0 
0 0 1 


, [R ] 2 = 


, [R ] 5 = 


c 7 0 ~s 

S 2 0 C; 
0 -1 0 


C s 

s 5 

0 1 0 


0 S 5 

0 -c. 


. [R ] 3 = 


, [R ] 6 = 


^3 0 S3 

S 3 0 -c, 
0 1 0 


C 6 0 ~S , 
S 6 0 C { 
0 -1 0 


Link 

Variable 

Twist 

a 

d 

1 

e> 

90. 

0. 

0. 

2 


-90. 

0. 

0. 

3 

©3 

90. 

0. 

8 

4 

e 4 

-90. 

0. 

0. 

5 

0s 

90. 

0. 

h 

6 

e« 

-90. 

0. 

0. 

7 

87 

0. 

0. 

0. 


Table 1 - D & H Parameters 


The screw coordinates of the joint axes are expressed with respect to the reference frames, ref 1 and ref 2, in terms of 
the rotation matrices in Tables 2 and 3 respectively. The operator z ([A]) is defined as z ([A]) = [A]{0, 0, 1 ) r . 

A screw quantity. S', known in frame s, can be transformed and expressed in frame, /, by 


& - ([»]>*'; R] a s* + [rj a s;} > rn A s* 


where [T] a = 


[R]/, [0] 

(p%[R]/i [R]> 


with [R] a the 3x3 rotation matrix describing the orientation of the frame s with respect to the frame /, \p] f a 3x3 skew 
symmetric (cross product matrix) of the location of the s reference origin with respect to the /origin expressed in the f 
reference coordinates, and [0] a 3x3 null matrix. Rotation matrices and displacement vectors required for transforma- 
tion of an end effector velocity screw known with respect to an inertially oriented, end effector tip located frame to the 
reference frames are ’ 


[RWi— = ([R]i[RJ2[R] 3 [R] 4 ) t , {/>#!_} = [R] 5 [R]«[R] 7 {xJ“- r 
[RWi^rf = ([R]i[R] 2 [R(e 3 )],) T , 

= {0, 0, g} r + [R(90)],[R] 4 {0, 0, h) T + [R(90)][R] 4 [R] s [R] 6 [R] 7 {x}"*^ 
where lx}"*' is the tip location with respect to an end effector oriented wrist located frame. 


i 


{sr^ 1 } 7 " 


5 

{0, 0, 1) 

{0, 0, 0) 

O 

z([R]s) 

{0, 0, 0} 

7 

z([R] 5 [R] 6 ) 

{0, 0, 0) 

4 

z([R]J) 

W&.JX ($;✓«) 

3 

z([R]J[R]I) 

uaL 1 } x {ss^m 

□ 

Bum 


D 

z([R] 4 [R] 3 (R] 2 [R]f) 

RPranan 


where {x%Uw}={0, 0, -h) T 

and (x^}={xatL}+[R]I[R]^{0, 0, -g) T 


Table 2 - 7R Joint Screw Coordinates {ref 1 reference) 


■ 

$^ 2 1 

{$^ 2 ) r 


a 

(0,0,1) 

HKsXXDlHi 

Q 

2 ((R(e 3 )i, r [R]^) 

IHSSX9H 

1 

2 ([R(0 3 )]r[R]I[R]D 

IHHEEXHB 

4 

z([R(90)]J 


a 

z([R(90)],[R] 4 ) 


Q 

*([R(90)],[R] 4 [R] 4 ) 



z((R(90)] x [R) 4 [R] s [R] 4 ) 

W&} X [$?2) 


where {x2&}={0,0,g} r 

and (4l?}={xa(^)+[R(90)],[R] 4 [0, 0, h) T 


Table 3 - 7R Joint Screw Coordinates ( ref 2 reference) 


Appendix 2 - a 32 , 042 , etc for Sj = 0, S« = 0 
„ _ -A5 3 C 4 S 4 (1 + h 2 ) - g(S 3 S 4 S s 2 - C 3 C 4 S 4 C 5 S 5 + h 2 S 3 S 4 ) 

;r<v . h‘) 

„ _ C 3 C 4 gh + C 3 h 2 +S 3 C 4 Cj S 5 + a^S^iSs + C 3 S 5 2 

* £^2 + ^2 ’• ®62 = ^ 3^5 * “ ® 32 *^ 4^5 * ^ 2^5 
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